package oldFiles;
import lejos.navigation.Pilot;
import lejos.nxt.*;
import lejos.navigation.*;

public class PilotTester {
	
	//public static Pilot pilot;
	
	//private static float wheeldiameter = 5.7F;
	private static float wheeldiameter = 7.0F;
	private static float wheelWidth =12.5F;
	
	private static int turnAngle = 90;
	
	public static void main(String[] args) throws InterruptedException {
		Pilot pilot = new TachoPilot(wheeldiameter,wheelWidth,Motor.B, Motor.C);
		//pilot.setSpeed(720);
		
		for (int i =0; i<10; i++) {
			pilot.travel(10);
			//Thread.sleep(1000);
			pilot.rotate(turnAngle);
			pilot.travel(10);
			pilot.rotate(turnAngle);
			pilot.travel(10);
			pilot.rotate(turnAngle);
			pilot.travel(10);
			pilot.rotate(turnAngle);
		}
		
	
	}
	
	
}
